Belgelerim/ceng_491/implementation/doxygen/TraffEdu_Developers_Manual_Reference_ToSource/PhysicsServer.cpp

Go to the documentation of this file.
00001 
00002 PhysicsServer PhysicsServer::_instance;
00003 
00004 
00005 PhysicsServer::PhysicsServer() :        _world(0),
00006                                                                         _space(0),
00007                                                                         _contactgroup(0),
00008                                                                         _envSpace(0),
00009                                                                         _ground(0)
00010 {
00011 }
00012 
00013 
00014 PhysicsServer::~PhysicsServer()
00015 {
00016         shutdown();
00017 }
00018 
00019 
00020 bool PhysicsServer::init(int groundSizeX, int groundSizeY)
00021 {
00022         if (groundSizeX <= 20 || groundSizeY <= 20)
00023                 return false;
00024 
00025         
00026         _world = dWorldCreate();
00027 
00028         
00029         _space = dHashSpaceCreate(0);
00030 
00031         
00032         _contactgroup = dJointGroupCreate (0);
00033 
00034         _envData.slip = 0.15; 
00035         
00036 
00037         
00038         dWorldSetGravity (_world,0,0,-(PHYS_GRAVITY*PHYS_MASS_SCALE));
00039         dWorldSetERP (_world, 0.6);
00040 
00041         
00042         _envSpace = dSimpleSpaceCreate(_space);
00043         _ground = dCreatePlane (_envSpace,0, 0, 1, 0);
00044         dGeomSetData(_ground, (void*)&_envData);
00045 
00046         
00047 
00048         return true;
00049 }
00050 
00051 
00052 void PhysicsServer::shutdown()
00053 {
00054 
00055         _clientList.clear();
00056 
00057 
00058         if(_contactgroup)
00059         {
00060                 dJointGroupDestroy (_contactgroup);
00061                 _contactgroup = NULL;
00062         }
00063 
00064         if (_space)
00065         {
00066                 dSpaceDestroy (_space);
00067                 _space = NULL;
00068         }
00069 
00070         if (_world)
00071         {
00072                 dWorldDestroy (_world);
00073                 _world = NULL;
00074         }
00075 }
00076 
00077 
00078 
00079 bool PhysicsServer::registerClient(PhysicsClient* client)
00080 {
00081         if (client == NULL)
00082                 return false;
00083 
00084 
00085         bool success = client->init(_world, _space, _envSpace );
00086 
00087         if (success)
00088                 _clientList.push_back(client);
00089 
00090         return success;
00091 }
00092 
00093 
00094 void PhysicsServer::collisionCallback (void *data, dGeomID o1, dGeomID o2)
00095 {
00096         
00097         if(data!=NULL){
00098                 PhysicsServer* serverPtr = (PhysicsServer*)data;
00099                 serverPtr->checkCollision(serverPtr, o1, o2);
00100         }
00101 }
00102 
00103 
00104 
00105 void PhysicsServer::checkCollision(void *data, dGeomID o1, dGeomID o2)
00106 {
00107         int i,n;
00108     if( dGeomIsSpace( o1 ) || dGeomIsSpace( o2 ) )
00109         {
00110                 dSpaceCollide2( o1, o2, data, &collisionCallback );
00111         }
00112         else
00113         {
00114                 int             mode    = 0;
00115                 double  slip1   = 0;
00116                 double  slip2   = 0;
00117 
00118 
00119                 dBodyID body1 = dGeomGetBody(o1);
00120                 dBodyID body2 = dGeomGetBody(o2);
00121 
00122                 PhysGeomData* pData1 = (PhysGeomData*)dGeomGetData(o1);
00123                 PhysGeomData* pData2 = (PhysGeomData*)dGeomGetData(o2);
00124 
00125 
00126                 if (pData1 != NULL)
00127                         slip1 = pData1->slip;
00128         
00129                 if (pData2 != NULL)
00130                         slip2 = pData2->slip;
00131         
00132         
00133                 if (slip1 != 0)
00134                         mode |= dContactSlip1;
00135 
00136                 if (slip2 != 0)
00137                         mode |= dContactSlip2;
00138 
00139                 static const int N = 8;
00140                 dContact contact[N];
00141                 n = dCollide (o1,o2,N,&contact[0].geom,sizeof(dContact));
00142                 if (n > 0) 
00143                 {
00144 
00145                         if(!(o1==_ground||o2==_ground)){
00146                         vector <PhysicsClient*>::const_iterator iter = _clientList.begin();
00147                         vector <PhysicsClient*>::const_iterator iter2;
00148                         dGeomID first,second;
00149                         int i=0;
00150                         for(;iter != _clientList.end();iter++)
00151                         {
00152                                 for(iter2=iter+1;iter2 != _clientList.end();iter2++)
00153                                 {
00154                                         first=(*iter)->getGeomID();
00155                                         second=(*iter2)->getGeomID();
00156                                         if(o1==first && o2==second)
00157                                         {
00158                                                 
00159 
00160                                                 (*iter)->setCollusion();
00161                                                 (*iter2)->setCollusion();
00162                                                 
00163                         
00164                                                 int j;
00165                                                 int size=crashedGeomIds.size();
00166                                                 for(j=0;j<size;j++)
00167                                                 {
00168                                                         if(crashedGeomIds.at(j) == first)
00169                                                                 break;
00170 
00171                                                 }
00172 
00173                                                 if(j == size)
00174                                                 {
00175                                                 crashedGeomIds.push_back(first);
00176                                                 crashedGeomIds.push_back(second);
00177 
00178                                                 alSourcePlay(sound_id);
00179                                 
00180                                                 }
00181                                                 i=1;
00182                                         }
00183                                         if(i==1) break; 
00184                                 }
00185                                 if(i==1) break;
00186                         }
00187                         }
00188 
00189                         for (i=0; i<n; i++) 
00190                         {
00191                           contact[i].surface.mode = mode; 
00192                           contact[i].surface.mu = dInfinity;
00193                           contact[i].surface.slip1 = slip1;
00194                           contact[i].surface.slip2 = slip2;
00195 
00196                           dJointID c = dJointCreateContact (_world, _contactgroup, &contact[i]);
00197                           dJointAttach (c, body1, body2);
00198                         }
00199                 }
00200         }
00201 
00202 }
00203 
00204 
00205 
00206 bool PhysicsServer::update(double step)
00207 {
00208         if (_world == 0 || _space == 0)
00209                 return false;
00210 
00211         dSpaceCollide (_space, this, &collisionCallback);
00212 
00213         vector <PhysicsClient*>::const_iterator iter = _clientList.begin();
00214         double speed;
00215         while(iter != _clientList.end() )
00216         {
00217                 
00218                 speed=(*iter)->update(step);
00219         iter++;
00220         }
00221  
00222 
00223     dWorldStep (_world, step);
00224                 
00225         
00226    dJointGroupEmpty (_contactgroup);
00227 
00228         return true;
00229 }
00230 
00231 void PhysicsServer::setCrashId(int soundId)
00232 {
00233         sound_id = soundId;
00234 }

Generated on Sun May 28 18:54:09 2006 for TraffEdu by  doxygen 1.4.6-NO